home *** CD-ROM | disk | FTP | other *** search
/ FM Towns: Free Software Collection 8 / FM Towns Free Software Collection 8.iso / t_os / otohime / src / lib / phase.asm < prev    next >
Assembly Source File  |  1994-06-01  |  10KB  |  431 lines
  1. ;    PCM SOUND PHASE SHIFT DELAY
  2. ;
  3. ;
  4. ;        Hiroshi TODA
  5. ;
  6. ;        1995 1 High C 用
  7. ;
  8. ;    phaseDelay( sourceSNDdata, distnationSNDdata, para, work ) ;
  9. ;    para:maindelay,phasedelay,mix1,mix2,md1,sp1,ang1,nd2,sp2,ang2
  10. ;    work:512Byte work area
  11. ; 
  12.  
  13.  
  14.     .386p
  15.  
  16.  
  17. param    struc
  18.  
  19.     dd    ?
  20.     dd    ?
  21. source    dd    ?        ; source snd.data address
  22. new        dd    ?        ; new snd.data address
  23. paradd    dd    ?        ; para. address
  24. wadd    dd    ?         ; work address
  25.  
  26. param   ends
  27.  
  28.  
  29. work    struc
  30.  
  31. ;data area
  32.  
  33. delay1    dd    ?        ; main delay Byte
  34. delay2    dd    ?        ; phase delay Byte
  35. mix1    dd    ?        ; main mix rate
  36. mix2    dd    ?        ; vibrato mix rate
  37. md1    dd    ?        ; modulation1
  38. sp1    dd    ?        ; speed1 (90 = 10000H)
  39. ang1    dd    ?        ; angle1
  40. md2    dd    ?        ; modulation2
  41. sp2    dd    ?        ; speed2 (90 = 10000H)
  42. ang2    dd    ?        ; angle2
  43.  
  44. point0    dd    ?        ; 10000H-point1
  45. point1    dd    ?        ; ov.sampling point (decimal)
  46. point2    dd    ?        ; ov.sampling point (integer)
  47. buf1    dd    ?        ; sampling add buf.
  48.  
  49. ;    これ以下 1995 1 に追加
  50. sourceStart    dd    ?        ; source data の 開始アドレス
  51. sourceEnd    dd    ?        ; source data の 終了アドレス
  52. dly        dd    ?        ; delay1 - delay2
  53.  
  54. work    ends
  55.  
  56.  
  57. cseg    segment    dword public use32 'CODE'
  58.     assume    cs:cseg,ds:cseg
  59.  
  60.     public    sndPhaseDelay
  61.     db    'sndPhaseDelay',13
  62. sndPhaseDelay    proc    near
  63.     push    ebp
  64.     mov        ebp,esp
  65.     push    esi
  66.     push    edi
  67.     push    ebx
  68.  
  69.     mov    esi,[ebp].wadd        ; esi <-- work area top add
  70.     mov    edi,[ebp].source    ; edi <-- source data add.
  71.     mov    ebx,[ebp].new        ; ebx <-- new data add.
  72.     mov    ecx,[ebp].paradd    ; ecx <-- para. add.
  73.     xor    edx,edx            ; edx=count
  74. main00:
  75.     mov    eax,[ecx][edx*4]    ; para. --> work area
  76.     mov    [esi][edx*4],eax
  77.     inc    edx
  78.     cmp    edx,10
  79.     jb    main00
  80.  
  81.     mov    eax,[esi].delay1    ; dly = delay1 - delay2
  82.     sub    eax,[esi].delay2
  83.     mov    [esi].dly,eax
  84.  
  85.     mov    edx,edi
  86.     add    edx,32
  87.     mov    [esi].sourceStart,edx    ; sourceStart = source start address
  88.     add    edx,[edi+12]
  89.     mov    [esi].sourceEnd,edx        ; sourceEnd = source end address
  90.  
  91.     mov    ecx,[edi+12]        ; length
  92.     cmp    ecx,0
  93.     jbe    mainE                ; jb を jbe に変更 1993 12
  94.  
  95.     xor    edx,edx                ; snd head trans
  96. main01:
  97.     mov    eax,[edi][edx*4]
  98.     mov    [ebx][edx*4],eax
  99.     inc    edx
  100.     cmp    edx,8
  101.     jb    main01
  102.  
  103.     add    ebx,32
  104.     add    edi,32
  105.     add    edi,[esi].delay2    ; ediはphaseに合わせる
  106.  
  107. main02:
  108.     mov    [esi].point2,edi    ; ov.sampling point cal.
  109.     xor    eax,eax
  110.     mov    [esi].point1,eax
  111.     mov    eax,[esi].ang1
  112.     call    sin            ; eax = sin(eax)*10000H
  113.     imul    dword ptr [esi].md1
  114.     mov    [esi].buf1,eax
  115.     mov    eax,[esi].ang2
  116.     call    sin            ; eax = sin(eax)*10000H
  117.     imul    dword ptr [esi].md2
  118.     add    eax,[esi].buf1
  119.     cdq
  120.     add    [esi].point1+2,eax
  121.     adc    word ptr [esi].point2+2,dx
  122.  
  123.     mov    eax,[esi].point2    ; source start～end check
  124.     cmp    eax,[esi].sourceEnd
  125.     jae    main021
  126.     cmp    eax,[esi].sourceStart
  127.     jae    main03
  128. main021:
  129.     xor    eax,eax
  130.     jmp    main04
  131. main03:
  132.     lea    eax,[esi].point1    ; over sampling
  133.     call    smp
  134. main04:
  135.     imul    eax,[esi].mix2        ; mix
  136.     mov    [esi].buf1,eax
  137.  
  138.     mov    eax,edi                ; source start～end check
  139.     add    eax,[esi].dly
  140.     cmp    eax,[esi].sourceEnd
  141.     jae    main041
  142.     cmp    eax,[esi].sourceStart
  143.     jae    main05
  144. main041:
  145.     xor    eax,eax
  146.     jmp    main06
  147. main05:
  148.     mov    edx,[esi].dly
  149.     mov    al,[edi][edx]
  150.     and    eax,0ffH
  151.     cmp    eax,128
  152.     jb    main06
  153.     mov    edx,eax
  154.     mov    eax,128
  155.     sub    eax,edx
  156. main06:
  157.     imul    eax,[esi].mix1
  158.     add    eax,[esi].buf1
  159.     sar    eax,8
  160.     js    main07            ; eax --> pcm data
  161.     je    main07
  162.     cmp    eax,128            ; +
  163.     jb    main08
  164.     mov    eax,127
  165.     jmp    main08
  166. main07:
  167.     mov    edx,eax            ; -
  168.     mov    eax,128
  169.     sub    eax,edx
  170.     cmp    eax,256-1    ; data255はloopStopの意味があるから除外 1993 12
  171.     jb    main08
  172.     mov    eax,255-1    ; data255はloopStopの意味があるから除外 1993 12
  173. main08:
  174.     mov    [ebx],al
  175.  
  176.     mov    eax,[esi].sp1
  177.     add    [esi].ang1,eax
  178.     mov    eax,[esi].sp2
  179.     add    [esi].ang2,eax
  180.     inc    edi
  181.     inc    ebx
  182.     dec    ecx
  183.     jne    main02
  184.  
  185. mainE:
  186.     pop    ebx
  187.     pop    edi
  188.     pop    esi
  189.     mov    esp,ebp
  190.     pop    ebp
  191.     ret
  192.  
  193. ;    OVER SAMPLING for PCM DATA(8bit)
  194. ;input    eax = 64bit(32bit/decimal,32bit/integer) data address(ds:)
  195. ;output    eax = over sampring data ( 32bit sign (-128 -- +127) )
  196.  
  197. smp:    push    ebx
  198.     push    ecx
  199.     push    edx
  200.     push    esi
  201.     push    edi
  202.     mov    ebx,[eax]        ; ebx = decimal
  203.     mov    esi,[eax+4]        ; esi = integer
  204.     shr    ebx,24            ; ebx --> 8bit
  205.     jne    smp00
  206.  
  207.     mov    al,[esi]        ; decimal=0
  208.     and    eax,0ffH
  209.     cmp    eax,128
  210.     jb    smp0A
  211.     mov    edx,eax
  212.     mov    eax,128
  213.     sub    eax,edx
  214. smp0A:    jmp    smp06
  215.  
  216. smp00:
  217.     mov    eax,[esi-1]        ; 周囲がみな無信号ならノイズを出さないよう直接0を返す
  218.     cmp    eax,80808080h
  219.     jne    smp0B
  220.     xor    eax,eax
  221.     jmp    smp06
  222.  
  223. smp0B:
  224.     call    smp01
  225. smp01:    pop    edi
  226.     add    edi,smptb-smp01        ; edi = table point
  227.  
  228.     mov    al,[esi]
  229.     and    eax,0ffH
  230.     cmp    eax,128
  231.     jb    smp02
  232.     mov    edx,eax
  233.     mov    eax,128
  234.     sub    eax,edx
  235. smp02:    add    eax,128
  236.     mul    byte ptr cs:[edi][ebx]
  237.     mov    ecx,eax
  238.  
  239.     mov    al,[esi-1]
  240.     and    eax,0ffH
  241.     cmp    eax,128
  242.     jb    smp03
  243.     mov    edx,eax
  244.     mov    eax,128
  245.     sub    eax,edx
  246. smp03:    add    eax,128
  247.     mul    byte ptr cs:[edi][ebx+256]
  248.     sub    ecx,eax
  249.  
  250.     mov    eax,ebx            ; ebx = 256 - ebx
  251.     mov    ebx,256
  252.     sub    ebx,eax
  253.  
  254.     mov    al,[esi+1]
  255.     and    eax,0ffH
  256.     cmp    eax,128
  257.     jb    smp04
  258.     mov    edx,eax
  259.     mov    eax,128
  260.     sub    eax,edx
  261. smp04:    add    eax,128
  262.     mul    byte ptr cs:[edi][ebx]
  263.     add    ecx,eax
  264.  
  265.     mov    al,[esi+2]
  266.     and    eax,0ffH
  267.     cmp    eax,128
  268.     jb    smp05
  269.     mov    edx,eax
  270.     mov    eax,128
  271.     sub    eax,edx
  272. smp05:    add    eax,128
  273.     mul    byte ptr cs:[edi][ebx+256]
  274.     sub    ecx,eax
  275.     sub    ecx,128*256
  276.     sar    ecx,8
  277.     mov    eax,ecx
  278.  
  279. smp06:    pop    edi
  280.     pop    esi
  281.     pop    edx
  282.     pop    ecx
  283.     pop    ebx
  284.     ret    
  285.  
  286. smptb    db    255,255,255,254,254,253,253,252
  287.     db    252,251,251,250,249,249,248,248
  288.     db    247,246,246,245,244,244,243,243
  289.     db    242,241,240,240,239,238,238,237
  290.     db    236,236,235,234,233,233,232,231
  291.     db    230,229,229,228,227,226,225,225
  292.     db    224,223,222,221,221,220,219,218
  293.     db    217,216,215,214,214,213,212,211
  294.     db    210,209,208,207,206,205,204,204
  295.     db    203,202,201,200,199,198,197,196
  296.     db    195,194,193,192,191,190,189,188
  297.     db    187,186,185,184,183,182,181,180
  298.     db    179,178,177,176,175,174,172,171
  299.     db    170,169,168,167,166,165,164,163
  300.     db    162,161,160,158,157,156,155,154
  301.     db    153,152,151,150,148,147,146,145
  302.     db    144,143,142,141,139,138,137,136
  303.     db    135,134,133,132,130,129,128,127
  304.     db    126,125,123,122,121,120,119,118
  305.     db    117,115,114,113,112,111,110,108
  306.     db    107,106,105,104,103,101,100,099
  307.     db    098,097,096,094,093,092,091,090
  308.     db    089,087,086,085,084,083,082,080
  309.     db    079,078,077,076,075,073,072,071
  310.     db    070,069,068,067,065,064,063,062
  311.     db    061,060,058,057,056,055,054,053
  312.     db    052,051,049,048,047,046,045,044
  313.     db    043,042,040,039,038,037,036,035
  314.     db    034,033,032,030,029,028,027,026
  315.     db    025,024,023,022,021,020,019,018
  316.     db    016,015,014,013,012,011,010,009
  317.     db    008,007,006,005,004,003,002,001
  318.  
  319.     db    000,000,001,001,001,002,002,002
  320.     db    003,003,003,003,004,004,004,005
  321.     db    005,005,005,006,006,006,006,007
  322.     db    007,007,007,008,008,008,008,009
  323.     db    009,009,009,009,010,010,010,010
  324.     db    010,011,011,011,011,011,011,012
  325.     db    012,012,012,012,012,013,013,013
  326.     db    013,013,013,013,014,014,014,014
  327.     db    014,014,014,014,014,015,015,015
  328.     db    015,015,015,015,015,015,015,015
  329.     db    015,016,016,016,016,016,016,016
  330.     db    016,016,016,016,016,016,016,016
  331.     db    016,016,016,016,016,016,016,016
  332.     db    016,016,016,016,016,016,016,016
  333.     db    016,016,016,016,016,016,016,016
  334.     db    016,016,016,016,016,016,016,016
  335.     db    016,016,016,016,016,016,016,016
  336.     db    016,016,015,015,015,015,015,015
  337.     db    015,015,015,015,015,015,015,015
  338.     db    014,014,014,014,014,014,014,014
  339.     db    014,014,014,013,013,013,013,013
  340.     db    013,013,013,013,012,012,012,012
  341.     db    012,012,012,012,012,011,011,011
  342.     db    011,011,011,011,011,010,010,010
  343.     db    010,010,010,010,009,009,009,009
  344.     db    009,009,009,008,008,008,008,008
  345.     db    008,008,007,007,007,007,007,007
  346.     db    007,006,006,006,006,006,006,005
  347.     db    005,005,005,005,005,004,004,004
  348.     db    004,004,004,003,003,003,003,003
  349.     db    003,002,002,002,002,002,002,001
  350.     db    001,001,001,001,001,000,000,000
  351.  
  352.  
  353.  
  354. sin:    push    ebx
  355.     push    ecx
  356.     push    edx
  357.     mov    edx,eax
  358.     and    edx,30000H
  359.     cmp    edx,10000H
  360.     je    sin01
  361.     cmp    edx,30000H
  362.     je    sin01
  363.     jmp    sin02
  364. sin01:    mov    bx,ax
  365.     mov    ax,0ffffH
  366.     sub    ax,bx
  367. sin02:    and    eax,0ffffH
  368.     call    sin03
  369. sin03:    pop    ecx
  370.     add    ecx,sintb-sin03
  371.     push    eax
  372.     shr    eax,8
  373.     mov    bx,cs:[ecx][eax*2]
  374.     mov    cx,cs:[ecx+2][eax*2]
  375.     and    ebx,0ffffH
  376.     and    ecx,0ffffH
  377.     sub    ecx,ebx
  378.     pop    eax
  379.     and    eax,0ffH
  380.     imul    eax,ecx
  381.     shr    eax,8
  382.     add    eax,ebx
  383.     cmp    edx,20000H
  384.     jb    sin04
  385.     mov    ebx,eax
  386.     xor    eax,eax
  387.     sub    eax,ebx
  388. sin04:    pop    edx
  389.     pop    ecx
  390.     pop    ebx
  391.     ret
  392.  
  393. sintb    dw    00000H,00192H,00324H,004B6H,00648H,007DAH,0096CH,00AFDH
  394.     dw    00C8FH,00E21H,00FB2H,01143H,012D5H,01465H,015F6H,01787H
  395.     dw    01917H,01AA7H,01C37H,01DC6H,01F56H,020E5H,02273H,02402H
  396.     dw    0250FH,0271DH,028AAH,02A37H,02BC3H,02D4FH,02EDBH,03066H
  397.     dw    031F1H,0337BH,03505H,0368EH,03816H,0399EH,03B26H,03CADH
  398.     dw    03E33H,03FB9H,0413EH,042C3H,04447H,045CAH,0474CH,048CEH
  399.     dw    04A4FH,04BD0H,04D4FH,04ECEH,0504DH,051CAH,05347H,054C3H
  400.     dw    0563EH,057B8H,05931H,05AAAH,05C21H,05D98H,05F0EH,06083H
  401.     dw    061F7H,0636AH,064DCH,0664DH,067BDH,0692CH,06A9AH,06C07H
  402.     dw    06D73H,06EDEH,07048H,071B1H,07319H,0747FH,075E5H,07749H
  403.     dw    078ACH,07A0FH,07B64H,07CCFH,07E2EH,07F8DH,080E7H,08242H
  404.     dw    0839BH,084F3H,0864AH,087A0H,088F5H,08A48H,08B99H,08CEAH
  405.     dw    08E39H,08F86H,090D3H,0921EH,09367H,094AFH,095F6H,0973BH
  406.     dw    0987FH,099C1H,09B02H,09C41H,09D7FH,09EBBH,09FF6H,0A12FH
  407.     dw    0A266H,0A39CH,0A4D1H,0A604H,0A735H,0A865H,0A993H,0AABFH
  408.     dw    0ABEAH,0AD13H,0AE3BH,0AF60H,0B085H,0B1A7H,0B2C8H,0B3E6H
  409.     dw    0B504H,0B61FH,0B739H,0B851H,0B967H,0BA7BH,0BB8EH,0BC9FH
  410.     dw    0BDAEH,0BEBBH,0BFC6H,0C0D0H,0C1D7H,0C2DDH,0C3E1H,0C4E3H
  411.     dw    0C5E3H,0C6E1H,0C7DDH,0C8D7H,0C9D0H,0CAC6H,0CBBBH,0CCADH
  412.     dw    0CD9EH,0CE8CH,0CF79H,0D063H,0D14CH,0D232H,0D317H,0D3F9H
  413.     dw    0D4DAH,0D5B8H,0D695H,0D76FH,0D847H,0D91DH,0D9F1H,0DAC3H
  414.     dw    0DB93H,0DC60H,0DD2CH,0DDF5H,0DEBDH,0DF82H,0E045H,0E106H
  415.     dw    0E1C4H,0E281H,0E33BH,0E3F3H,0E4A9H,0E55DH,0E60EH,0E6BDH
  416.     dw    0E76AH,0E815H,0E8BEH,0E964H,0EA08H,0EAAAH,0EB4AH,0EBE7H
  417.     dw    0EC82H,0ED1BH,0EDB1H,0EE45H,0EED7H,0EF67H,0EFF4H,0F07FH
  418.     dw    0F108H,0F18EH,0F212H,0F293H,0F313H,0F390H,0F40AH,0F483H
  419.     dw    0F4F9H,0F56CH,0F5DDH,0F64CH,0F6B9H,0F723H,0F78AH,0F7F0H
  420.     dw    0F852H,0F8B3H,0F911H,0F96DH,0F9C6H,0FA1DH,0FA72H,0FAC4H
  421.     dw    0FB13H,0FB60H,0FBABH,0FBF4H,0FC3AH,0FC7DH,0FCBEH,0FCFDH
  422.     dw    0FD39H,0FD73H,0FDAAH,0FDDFH,0FE12H,0FE42H,0FE6FH,0FE9AH
  423.     dw    0FEC3H,0FEE9H,0FF0DH,0FF2EH,0FF2EH,0FF4DH,0FF83H,0FF9BH
  424.     dw    0FFB0H,0FFC2H,0FFD2H,0FFE0H,0FFEBH,0FFF3H,0FFFAH,0FFFDH
  425.     dw    0FFFFH
  426.  
  427. sndPhaseDelay    endp
  428.  
  429. cseg    ends
  430.     end
  431.